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ABSTRACT 

The  aim  of  this  project  is  to  evaluate  automatic  com¬ 
pensation  for  moving  targets  in  the  supervisory  control  of 
remote  manipulators. 

An  experimental  system  was  built  which  consists  of  a 
master/slave  manipulator,  a  moving  table  for  the  moving  ob¬ 
ject,  and  a  computer  controlling  both  the  manipulator  and  the 
table. 

A  software  system  was  made  which  allows  the  master/ 
slave  operation  with  object  motion  compensation  under  computer 
control.  The  method  of  resolved  motion  rate  control  was 
adopted  for  the  manipulator  control.  The  computation  time 
in  this  way  proved  practical  and  permitted  a  system  seunpling 
interval  of  0.05  s. 

Experiments  were  carried  out  with  human  operators  per¬ 
forming  manipulation  tasks  in  the  master/slave  operation 
under  computer  control.  Their  performance  was  compared 
in  three  situations:  no  object  motion,  compensation  for  the 
object  motion,  and  no  compensation.  The  comparison  of  the 
compensation  and  no  compensation  situations  showed  that  the 
compensation  reduced  the  operation  time  by  26  <-  41%  in  the 
peg  moving  task  and  increased  the  accuracy  by  two  and  a  half 
times  in  rectangle  tracing.  In  valve  turning,  however,  a 
significant  improvement  was  not  observed. 

Thus,  it  can  be  concluded  that  the  compensation  for 
target  motion  can  improve  the  performance  of  the  human  operator 
significantly  in  certain  kinds  of  tasks. 
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1.  INTRODUCTION  TO  SUPERVISORY  CONTROL  OF  REMOTE  MANIPULATORS 

The  new  environments  man  is  working  in  with  great  hope  are: 
Outer  space,  undersea,  and  nuclear  radioactive.  One  problem  en¬ 
countered  by  people  who  are  trying  to  perform  activities  in  these 
areas  is  their  physiological  hositility,  which  keeps  people 
distant  from  them.  Either  they  must  stay  physically  remote  or 
remain  isolated  by  special  garments  or  capsules. 

Manipulators  have  been  developed  to  extend  the  man's  cap¬ 
ability  while  keeping  him  away  from  the  dangerous  working 
site.  The  work  done  with  manipulators,  such  as  repairing  and 
maintenance  of  equipment,  is  not  routine  work,  but  varies  from 
time  to  time  according  to  the  state  of  the  equipment,  and  re¬ 
quires  good  judgment,  dexterity,  and  great  care. 

The  manipulators  are  usually  controlled  by  a  human  operator 
in  rate  control  or  master/slave  control.  Operating  manipulators 
in  this  way  is  a  tiring  job  and  the  operator  gets  exhausted  after 
a  short  time  of  work. 

The  use  of  the  computer  has  been  introduced  to  help  the 
operator.  Ferrell  and  Sheridan  [1]  in  1967  proposed  the  super¬ 
visory  control  of  manipulation,  where  the  computer  can  be  to  some 
extent  autonomous,  controlling  the  manipulator  on  its  own,  and 
the  human  operator,  released  from  the  direct  control  loop  in 
which  he  had  to  take  care  of  every  tiny  motion  of  the  manipulator, 
can  become  a  supervisor  of  the  semi-autonomous  manipulator  or 
robotic  device. 


2 .  PROBLEMS  IN  THE  MANIPULATION  OF  MOVING  OBJECTS 


Undersea  tasks  done  by  hianan  divers  are  getting  more  and 
more  costly  and  hazardous  as  they  have  to  be  done  at  increasing 
depth  [2] .  Using  a  manipulator  mounted  on  an  unmanned  movable 
submersible  and  controlling  it  from  the  sea  surface  is  the 
most  desirable  solution  provided  that  the  task  can  be  performed 
reasonably  well.  But  the  use  of  the  manipulator  has  its  own 
problems.  One  of  them  is  the  relative  motion  between  the  man¬ 
ipulator  and  the  object,  which  wasn't  really  a  problem  at  all 
in  the  case  of  human  divers  [3] . 

Underseas  a  submersible  with  a  manipulator  may  fix  itself 
to  the  sea  bottom,  but  the  object  the  manipulator  must  handle 
may  be  moving  about  in  the  water,  drifting  due  to  the  force  of 
the  current.  Or,  conversely,  the  object  may  be  fixed  and  the 
submersible  with  the  manipulator  may  be  moving  around;  or,  both 
can  be  moving. 

In  any  of  these  cases  there  is  relative  motion  between  the 
manipulator  and  the  object  which  the  manipulator  is  to  handle. 

The  preprogrammed  task  motion  may  fail  because  the  object  simply 
isn't  where  it  is  supposed  to  be.  If  the  manipulator  is  con¬ 
trolled  in  master/slave  mode,  the  human  operator  must  make  the 
slave  follow  the  object,  i.e.  he  has  to  follow  it  himself  on 
the  master,  and  do  his  proper  detail  manipulation  job  in  addition. 
As  is  easily  imagined,  this  makes  his  work  a  lot  harder. 

If  the  relative  motion  of  the  object  can  be  measured,  ob¬ 
ject  motion  compensation  can  be  accomplished.  That  i?,  in 
master/slave  mode  the  object  motion  is  added  to  the  master  motion 
to  give  a  reference  to  the  slave  motion,  and  is  subtracted 
from  the  slave  motion  to  give  the  reference  to  the  master  motion. 
In  a  preprogrcunmed  task  mode  the  object  motion  is  superimposed 
on  the  predetermined  slave  motion.  So,  in  master/slave  mode. 
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despite  relative  motion  the  operator  can  perform  the  same 
task  motion  as  if  the  object  were  staying  still. 

In  this  project,  a  method  of  object  motion  compensation  is 
developed,  and  experiments  are  conducted  about  the  performance 
of  task  operation  in  master/slave  mode  with  moving  objects, 
assuming  that  the  controller  can  know  the  relative  motion  of 
the  object. 


3.  HARDWARE  FOR  THE  EXPERIMENT 


It  may  help  one  to  understand  what  has  been  done  in  this 
project  if  the  devices  used  in  the  experiment  are  described 
briefly. 

A  master/slave  manipulator  which  has  been  in  use  for  a 
long  time  in  the  Man-Machine  Systems  Laboratory  was  used  in  this 
project  (Fig.  3.1).  A  new  PDPll/34  minicomputer  was  used  to 
perform  the  control  job.  A  movable  table  was  brought  back 
to  life,  offering  three-dimensional  (x,y,z)  motion  under  the 
computer  control  to  the  object  which  is  handled  by  the  man¬ 
ipulator  (Fig.  3.2.  Also,  see  Appendix  C) . 

The  manipulator  is  an  Argonne  National  Laboratory  E2 
master/slave  manipulator.  It  is  articulated  type  with  six  de¬ 
grees  of  freedom  (6^,  0^^,  0^,  0^^,  0^^,  0^)  excluding  gripping 
action,  and  can  be  modeled  as  shown  in  Fig.  3.3  along  with 
its  dimensions  [3] .  The  master  and  the  slave  have  the  same 
contruction,  both  being  electromechanical  except  that  the 
master  has  a  grip  v/hich  fits  the  human  hand  and  the  slave  a 
gripper  similar  to  a  pair  of  tongs.  The  electric  drive  is  by 
means  of  10  Watt  115  Volt  60  Hz  A.C.  motors.  The  upper  three 
joints  (0  ,0  ,0  )  are  connected  to  their  motors  by  means  of 

2  X  X 

gears.  The  lower  three  joints  (6^  9r,  ©»)  and  the  grip  are 

connected  to  their  motors  by  means  of  cables  and  pulleys. 

A  servo  has  been  constructed  to  control  each  joint  angle 
with  its  potentiometer  output  compared  to  the  reference  input 
value.  In  master/slave  mode,  in  which  the  computer  control  can 
be  irrelevant,  the  master  servo  and  the  slave  servo  are  coupled 
to  give  the  master/slave  control  loop  shown  in  Fig.  3.4. 

This  allows  bilateral  control  with  force  feedback.  To  improve 
stability,  two  other  loops  are  present;  a  tachometer  feed- 
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Fig.  3.4.  Generalized  Block  Diagram  of  Servo  Control  Loop 
in  Master/Slave  Mode  (Modified  from  Brooks [3]) 


in  Computer  Control  Mode  (from  Brooks [3]) 


forward  cmd  a  tachometer  feedback  loop.  In  the  computer 
control  mode  the  servos  for  the  master  and  the  slave  act 
independently  in  reference  to  their  respective  input  values 
from  the  computer  as  shown  in  Fig.  3.5. 

The  manipulator  was  originally  controlled  by  an  Inter¬ 
data  Model  70  computer.  Thus  the  need  arose  to  change  its 
computer  interface  completely  to  fit  the  new  computer,  a  PDPll/34. 
Details  of  this  interface  are  discussed  in  Appendix  B. 

A  Data  Aquisition  and  Distribution  System  ANALOGIC  AN5400 
is  used  to  allow  the  computer  to  communicate  with  the  experimental 
devices.  The  AN5400  is  connected  through  a  General-Purpose 
Interface  Module  DRll-C  to  the  PDPll/34.  it  has  an  A/D  con¬ 
vertor  and  a  multiplexer  providing  32  channels  of  analog  input, 

16  D/A  converters,  32  bits  of  digital  input,  32  bits  of  digital 
output,  and  a  7-digit  octal  dial  on  the  panel  which  can  be 
read  by  the  computer. 

The  computer  can  take  the  following  actions  based  on  signals 
from  or  to  the  manipulator  through  the  AN5400. 

a)  input  the  joint  angles  of  the  manipulator; 

b)  input  the  gripping  force  of  the  slave  tongs; 

c)  switch  between  the  two  control  modes:  master/ 
slave  and  computer  control; 

d)  output  the  reference  values  to  the  manipulator 
servos  in  the  computer  control  mode,  or  the 
angular  differences  between  the  master  and 

the  slave  in  master/slave  mode. 

The  computer  can  also  take  care  of  the  table  action  through 
the  AN5400. 


a)  see  if  the  carriage  has  hit  any  of  the  limit  switches; 


b)  specify  the  speed  and  the  direction  of  the  carriage 
motion  along  the  three  axes  (x,y,z) . 


The 

Appendix 


details  of  the  AN5400  and  the  DRll-C  are  given  in 


A. 
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4.  CONTROL  THEORY  OF  THE  MANIPULATOR  MOTION 


The  manipulator  can  be  modeled  as  shown  in  Fig.  3.3.  It 
has  six  degrees  of  freedom.  Although  the  joint  angles  can  repre¬ 
sent  the  manipulator  motion  by  themselves,  cartesian  coordinate 
systems  give  more  convenience  and  flexibility  to  the  control. 

Frame  0  is  defined  at  the  manipulator  base  and  fixed  to 
the  vehicle.  Each  joint  of  the  arm  is  assigned  a  coordinate 
system,  starting  with  frame  1  at  the  first  joint  out  to  the  hand 
which  is  designated  as  frame  6. 

The  joint  angles  0j^  specify  the  rotation  of  the  kth  frcime 
with  respect  to  the  previous  frame  (k-1) . 

According  to  the  notation  given  by  T.  Brooks  [3] ,  the  trans¬ 
formation  from  the  hand  frame  to  the  vehicle  frame  is  given  as 


Also  the  transformation  from  the  fourth  frame  (wrist  frame) 
to  the  vehicle  fraune  is  given  as 


Tables  D.l  and  D2  show  the  expression  of  ®A^  and  ^Ag . 

Suppose  one  is  given  the  following  problem;  given  a  position 
(x,y,z)  ,  find  the  joint  angles  9^^  through  9g  that  place  the 
manipulator  at  that  position.  A  look  at  the  transformation  mat¬ 
rices  ®A.  and  ®A,  shows  that  9_  and  0,  are  irrelevant.  Solvina 
4  6  5  6 

through  9^  given  x,  y,  and  z  is  a  redundant  system  and  yields 
an  infinite  number  of  solutions.  Some  constraint  could  be 
given  to  make  the  system  non-redundant  but  the  problem  is  that 
the  system  is  analytically  insolvable. 
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One  of  the  methods  to  overcome  this  difficulty  is  Resolved 
Motion  Rate  Control  (RMRC)  proposed  by  D.  Whitney  14] . 

X  =  f (^) , 

where  x  is  a  position  vector  at  time  t, 


X  =  (X^  ,Xj^  ,  . . .  ,x^)  , 


and  ?  is  a  vector  of  joint  2uigles  at  time  t, 


{®1»  * ■ ’ ' ®m^ ' 


If  we  define  a  Jacobian  matrix  as 


3x, 


JQ. 


J(0)  = 


3x. 


n 


T5: 


3x, 


m 


3x. 


IT 


m 


we  get  the  following  relation; 

X  =  j(?)  T 

since  this  is  a  linear  system,  5  can  be  solved  for  given  x  if 
m  »  n  and  J(?)”  exists. 

0  »  J(0) 


As  for  a  short  period  of  time.  At, 

Ae  »  0At 

Ax  *  xAt 

A?  »  J(^)“^Ax 
0 ( t+At)  ■  ?  +  A0 

»  ^  +  Ax 


Wj-*  ■ 


For  the  implementation  of  this  method  one  variable  is  intro¬ 
duced  in  addition  to  x,  y,  and  z.  Suppose  the  hand  direction 
vector  as  referenced  to  frame  0  is  (s,l,0).  Since  the  vec¬ 
tor  is  perpendicular  to  ^y  regardless  of  0^  and  0g,  the  inner 
product  of  ^x  and  ^y  should  be  zero. 

(  ^12*  ^14^  "  ~ 

which  can  be  rewirtten 


So  a  new  variable 


is  introduced,  which  is  to  be  made  zero  in  the  control. 
In  this  case  n  =  4  and 
X  =  (x,y,z,p) , 

9  —  (9j^,02»92'®4^* 

To  keep  vector  y  horizontal, 


which  gives 

6-+- 

The  additional  constraint  of  keeping  the  hand  vector  x 
horizontal  gives 


which  gives 

Table  D.3  shows  the  elements  of  the  Jacobian  matrix  and 
the  expression  of  the  bases  of  the  joint  angles;  0^^  and  Ogj.. 


5.  MASTER/SLAVE  OPERATION  WITH  OBJECT  MOTION  COMPENSATION 
UNDER  COMPUTER  CONTROL 

If  the  object  to  be  manipulated  is  moving,  it  is  desirable 
to  compensate  the  object  motion  for  easy  operation  by  a  human 
operator.  By  compensation  is  meant  that  the  slave  manipulator 
hand  moves  with  the  object  motion  and  in  addition  makes  the 
necessary  motion  to  do  the  task  on  the  object,  while  the  master 
makes  the  latter  motion  only.  In  this  compensated  master/slave 
operation,  the  reference  given  to  the  slave  will  be  the  master 
position  plus  the  object  position,  and  the  reference  given  to  the 
master  will  be  the  slave  position  minus  the  object  position. 

Since  the  object  position  is  given  in  the  cartesian  coordin¬ 
ate  system  fixed  to  the  frame  0  of  the  manipulator  and  the  drive 
is  done  on  the  joint  angles,  this  control  necessitates  the  trans¬ 
formation  from  the  angle  representation  to  the  cartesian  repre¬ 
sentation  as  well  as  the  other  way  around. 

The  conceptual  diagram  of  this  control  is  shown  in  Fig. 

5.1. 

As  discussed  in  the  previous  chapter,  given  the  cartesian 

6 

position  of  the  manipulator  (x,y,2)  and  the  hand  vectors  y  = 

(s,l,0)  and  ®x  horizontal,  the  RMRC  logic  yields  the  six  angles 

through  Qg^,*  From  this  state  any  angular  value  9g^  can  be 

superimposed  on  the  base:  9^  without  giving  any  effect  back  to 

or 

9g^  through  9j^^. 

Thus  the  degrees  of  freedom  of  the  compensated  master/slave 
operation  are  five:  x,  y,  z,  s,  and  ^g^jf  excluding  the 
gripping  motion,  which  is  not  included  in  the  computer  control 
but  is  retained  in  master/slave  mode  by  itself.  Thus,  this 
control  System  has  one  less  degree  of  freedom  than  the  manipulator 
mechanism  has.  The  recovery  of  this  lost  degree  of  freedom 
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Fig,  5,1,  Conceptual  Block  Diagram  of  Master/Slave  Operation 

with  Object  Motion  Compensation  Under  Computer  Control 


could  be  had  at  the  cost  of  considerable  amount  of  additional 
computation. 

By  the  use  of  a  digital  computer,  the  master /slave  control 
system  becomes  a  discrete  time  sampling  system.  The  sampling 
time  interval  was  chosen  to  be  one  twentieth  of  a  second  (0.05  s) . 
The  interval  of  0.1  s  was  tried  but  proved  to  produce  motion  which 
was  too  shaky.  The  system  clock  of  the  RSX-llM  operating  sys¬ 
tem  which  works  on  the  60  Hz  line  frequency  is  used. 


t 


6.  PRACTICAL  PROBLEMS  IN  IMPLEMENTATION 

In  the  course  of  developing  programs  many  problems  have 
emerged.  One  is  how  to  make  the  master  operation  by  the  human 
operator  easy.  Most  of  the  remaining  problems  are  concerned 
with  stability.  The  measures  taken  are  hardly  academic. 

6.1  Master/Slave  Operation  Under  Computer  Control 

Simply  using  the  master  position  as  the  reference  to  the 
slave  and  the  slave  position  as  the  reference  to  the  master  has 
led  to  a  swaying  vibration  of  the  manipulator.  The  following 
scheme  is  used  to  prevent  this  vibration. 

d-*) 

X  =  a*x  +  (1-a) 'x  , 
mr  s  m ' 


where  x^  and  x^^  are  the  positions’  of  the  slave  and  the  master 

at  the  sampling  time  t,  and  x  _  and  x  are  the  reference  values 

sr  mr 

output  from  the  computer  to  which  the  slave  and  the  master  are 
controlled.  Experiments  have  shown  that  a  value  over  0.7  for 
a  brings  about  the  vibration. 

The  above  scheme  still  has  a  problem  in  that  the  master  is 
too  heavy  to  be  moved  by  a  human  operator.  The  use  of  tachometer 
feed-forward  in  the  master/slave  mode  has  suggested  the  following 
scheme  [3] . 


x^^  =  a-x  +  (1-a) -x^  +  b* (x^  -  x^-) 
sr  m  s  s  s^ 


X  =  a‘x^  +  <l-a) 'X  +  b- (x^  -  x  -) , 
mr  s  mm  m^ 


where  Xg2  positions  of  the  slave  and  the  master 

taken  two  cycles  earlier.  These  values,  Xg2  ^m2'  used 

because  the  use  of  x  ,  and  x  , ,  which  are  the  positions  taken  one 

SI  mi 
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cycle  earlier,  has  caused  vibration.  A  value  over  0.5  for 
b  causes  the  self-initiated  motion  of  the  manipulator. 


6.2.  Compensation  of  the  Object  Motion 

The  compensation  of  the  object  motion  has  introduced  new 
problems  concerned  with  the  dyneimics  of  the  manipulator.  If 
the  slave  is  following  the  object  motion  and  the  master  is  com¬ 
pensated,  the  value  given  from  the  slave  to  the  master/slave 
scheme  should  be  (x^  -  x^)  and  (^^2  “  reference  to 

the  slave  should  be  increased  by  x  ,  where  x.  is  the  table 

u 

position  at  the  sampling  time  t  and  x^2  is  that  two  cycles 
earlier,  and  x^^  is  the  position  where  the  table  is  expected 
to  be  a  certain  time  in  the  future. 


This  lead  time  is  understood  to  result  from  the  delay  time 
of  the  manipulator  drive  and  the  discrete  updating  of  the  re¬ 
ference  signals  by  the  computer.  The  proper  lead  time  is 
chosen  by  experiment.  Figure  6.1  shows  how  this  lead  time  takes 
care  of  both  the  delay  time  of  the  manipulator  and  the  effect 
of  the  reference  signals  which  do  not  change  continuously  but 
change  at  the  sampling  time  and  stay  constant  during  the 
cycle . 

The  lead  time  derived  by  experiment  is; 

X :  0.10  s 

y :  0.10  s 

z :  0.15  s . 

Too  small  a  lead  time  makes  the  master  move  in  the  opposite 
direction  to  the  object  motion,  while  too  big  a  lead  time  makes 
the  master  move  in  the  same  direction.  Too  small  a  lead  time 
also  makes  the  manipulator  follow  behind  the  object,  while  too 
big  a  lead  time  makes  the  manipulator  go  ahead  of  the  object. 
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output  signal  from  the  computer 


In  a  practical  application  where  the  object  motion  is 
measured,  the  prediction  of  the  object  position  is  necessary 
[5] .  In  this  project,  where  the  object  is  moved  in  a  predeter¬ 
mined  way,  it  is  easy  to  achieve,  but  it  may  be  difficult 
in  practice. 

The  eventual  scheme  is  as  follows: 

*sr  ■  *ta 

6.3  Resolved  Motion  Rate  Control 

For  the  resolved  motion  rate  control  program  the  following 
method  was  used. 

Given  0^  through  0^,  x,  y,  and  z  are  calculated.  Given 
the  destination  position  (x^,  y^,  z^,  s^) ,  the  variable 

4  ,  4 

p  >  s^-  <■  a^2 

is  evalxoated.  The  partial  derivatives  are  evaluated  forming  the 
Jacobian  matrix 


JC0)  = 


3x 

3x 

3x 

3x 

90j_ 

302 

303 

304 

3y 

3y 

3y 

39j^ 

302 

303 

304 

3z 

3z 

3z 

3z 

36^ 

302 

363 

304 

-TI7 

3p 

3p 

363 

304 

The  position  increments  are  calculated  as  follows: 
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Ax  =  -  X 

Ay  =  -  y 

Az  =  2^  -  z 
Ap  =  -p 

Now  the  equation  to  be  solved  is 
Ax  =  J(^)  A^. 

The  matrix  is  4x4,  not  too  large,  and  one  element  9x/36^  is 
zero.  Taking  advantage  of  this  fact,  an  economized  version 
of  the  method  developed  by  T.  Banachiewicz  [6]  is  used  instead 
of  a  general  method. 

The  variables  x,  y,  z,  p  and  their  partial  derivatives 
are  made  of  terms  which  consist  of  the  combinational  multiplica¬ 
tion  of  the  trigonometric  functions  of  0^  through  0^.  At 
first  glance  their  computation  looks  time  consviming  but  further 
inspection  reveals  a  lot  of  duplications  of  the  same  terms, 
which  enables  simplication  of  the  computation.  Comparison  of 
Tables  D.3  and  D.4  shows  how  much  calculation  was  saved  by  the 
simplification.  One  cycle  of  this  program  takes  8.8  ms  on  the 
PDPll/34.  The  control  needs  two  cycles,  one  for  the  master 
and  one  for  the  slave.  This  computation  time  is  quite  accept¬ 
able  and  compared  with  the  system  sampling  interval  0.05  s. 

6.4  Model  Angles  and  Mechanical  Angles  of  the  Manipulator 

Due  to  the  mechanism  of  the  manipulator,  the  mechanical 
joint  angles  0^^,  6^,  6^,  9^,  9^^,  and  0^  are  not  quite  the 
scime  as  the  angles  shown  in  Fig.  3.3.  Three  of  the  angles  are 
the  same . 
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with  a  link  connection, 


With  the  differential  gear  mechanism  using  33/40  gear  ratio, 
0g  =  (0^  -  0j^)/1.65. 

With  the  interference  of  9^  over  9^  in  addition, 

®5  "  '®3* 
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7.  EXPERIMENTS  ON  THE  PERFORMANCE  OF  HUMAN  OPERATORS 

Experiments  were  carried  out  to  evaluate  how  compensation 
for  the  moving  object  helps  the  hiiman  operator.  Operator  per¬ 
formances  are  compared  for  the  three  situations;  no  relative 
motion  between  the  object  and  the  manipulator  base,  relative 
motion  between  them  but  with  compensation,  and  relative  motion 
but  no  compensation. 

The  motion  of  the  object,  or  the  motion  of  the  table,  which 
actually  was  the  relative  motion  between  the  object  and  the 
manipulator  base,  was  arbitrarily  chosen  as  follows: 

X  =  1.4  sin{6. 2832/5. 0)t  -  5.6  sin (6 . 2832/14 . 5) t 

y  =  1.4  sin(6. 2832/6. 5) t  -  5.6  sin ( 6 . 2832/18 . 5) t 

z  =  0.4  cos(6. 2832/5. 0) t  -  0.4  cos ( 6 . 2832/6 . 5) t , 

where  x,  y,  and  z  are  expressed  in  inches  and  t  in  seconds. 

The  master/slave  operation  under  computer  control  was  chosen 
for  all  of  the  three  situations  to  provide  equal  degrees  of  free¬ 
dom  of  the  manipulator  motion  and  equal  ease  of  master  handling, 
although  master/slave  mode  without  computer  could  have  been 
used  for  the  no  object  motion  and  no  compensation  situations. 

Three  kinds  of  experiments  were  conducted:  peg  movement, 
valve  turning,  and  rectangle  tracing. 

In  the  peg  movement  experiment  (Fig.  7.1)  a  peg  was  used 
which  consisted  of  a  2.6"  x  2.4"  x  0.8"  board  to  be  gripped 
by  the  slave  tongs  and  a  0,39"  dia.  x  1,25"  pin  sticking  out 
of  the  board.  A  bocird  was  mounted  on  the  table  carriage  which 
had  eight  holes  of  0.44"  diameter  arranged  in  2  x  4  array  with  3" 
intervals.  Seven  of  the  holes  had  0.1"  champher  and  were 
used  for  the  experiment.  The  subject  operator  was  told  to 
insert  the  peg  pin  into  one  hole  and  move  it  into  the  next  and 


Fig.  7,1.  Peg  Moving  Task 


Pig.  7.2.  Operation  Time  for  the  Peg  Moving 


so  on  around  the  board.  The  time  was  measured  from  the  inser¬ 
tion  into  the  first  hole  to  the  insertion  into  the  same  hole 
after  one  round  of  travel.  Each  subject  made  five  trials  for 
each  situation. 

Fig.  7.2  shows  the  results  of  this  experiment.  The  mark 
shows  the  average  time  and  the  arrows  show  the  standard  deviation 
for  each  subject.  The  figure  shows  that  with  compensation  the 
operation  time  is  18  to  51%  (29%  average)  greater  than  with  no 
object  motion,  but  26  to  41%  (32%  average)  less  than  without 
compensation . 

In  the  second  experiment  (Fig.  7.3)  a  valve  was  mounted  on 
the  table  carriage.  Time  during  which  the  subject  rotated  the 
valve  two  turns  was  measured.  Fig.  7.4  shows  the  results  of 
this  experiment.  This  experiment  did  not  show  clear  differences 
between  situations. 

The  reasons  for  this  seem  to  be  as  follows;  In  the  peg 
movement  task  the  manipulator  positioning  is  initiated  by  the 
operator.  But  in  the  valve  turning  task  most  of  the  manipula¬ 
tor  positioning  is  initiated  by  the  slave  which  grips  the  moving 
valve  firml;^'.  The  peg  movement  task  is  rather  easy  with  no  ob¬ 
ject  motion  at  all  and  gets  a  little  awkward  with  motion  and 
compensation  and  more  awkward  without  compensation.  On  the 
other  hand,  the  valve  turning  task  is  as  awkward  in  one  situation 
as  in  any  other. 

The  valve  turning  in  this  way  may  be  an  inhuman  task.  Po¬ 
sitioning  of  the  manipulator  tongs  by  the  human  operator  and 
automatic  turning  of  the  valve  by  the  computer,  which  was  ex¬ 
perienced  in  T.  Brooks'  thesis  [3],  might  show  different  re¬ 
sults. 
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In  the  third  experiment  a  piece  of  paper  which  has  con¬ 
centric  4"  X  6"  and  3"  x  5"  rectangles  drawn  on  it  is  placed  on 
the  carriage.  The  rectangle  in  the  middle  of  the  two  is  con¬ 
sidered  as  the  reference  rectangle.  The  subject  was  requested 
to  trace  the  reference  rectangle  with  a  magic  marker  gripped 
by  the  slave.  The  eight  greatest  errors  of  the  trace  from  the 
reference  rectangle  were  measured  and  their  mean  value  was 
computed.  For  the  selection  of  the  eight  errors  the  follow¬ 
ing  rule  was  adopted: 

Take  the  maximum  error.  Discard  all  the  errors 
in  the  same  direction  (inside  or  outside)  within 
the  neighborhood  of  one  inch  (measured  on  the 
reference  rectangle)  from  the  previous  error  point. 

Take  the  maximxam  error  from  the  rest.  Repeat 
this  operation  until  eight  valuas  have  been 
chosen . 

Figure  7.6  shows  the  examples  of  the  traces  drawn  with  the 
manipulator.  Figure  7.7  shows  the  comparative  errors  for  the 
three,  situations.  With  compensation  the  average  error  is 
about  twice  as  big  as  with  no  object  motion  but  two  and  a  half 
times  as  small  as  without  compensation. 


Rectangle  Tracing 


(a)  no  table  motion  (e  =  0.156) 


(b)  compensation  (e  =  0.275) 

Pig.  7.6.  Examples  of  Rectangle  Traces 
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Fig.  7.7.  Comparative  Errors  in  Rectangle  Tracing 


8.  CONCLUSIONS 


The  aim  of  this  project  is  to  evaluate  automatic  com¬ 
pensation  for  moving  targets  in  the  supervisory  control  of 
remote  manipulators. 

An  experimental  system  was  built  which  consists  of  a 
master/slave  manipulator,  a  moving  table  for  the  moving  ob¬ 
ject,  and  a  computer  controlling  both  the  manipulator  and  the 
table. 

A  software  system  was  made  which  allows  the  master/ 
slave  operation  with  object  motion  compensation  under  computer 
control.  The  method  of  resolved  motion  rate  control  was 
adopted  for  the  manipulator  control.  The  computation  time 
in  this  way  proved  practical  and  permitted  a  system  sampling 
interval  of  0.05  s. 

Experiments  were  carried  out  with  human  operators  per¬ 
forming  manipulation  tasks  in  the  master/slave  operation 
under  computer  control.  Their  performance  was  compared 
in  three  situations:  no  object  motion,  compensation  for  the 
object  motion,  and  no  compensation.  The  comparison  of  the 
compensation  and  no  compensation  situations  showed  that  the 
compensation  reduced  the  operation  time  by  26  -  41%  in  the 
peg  moving  task  and  increased  the  accuracy  by  two  and  a  half 
times  in  rectangle  tracing.  In  valve  turning,  however,  a 
significant  improvement  was  not  observed. 

Thus,  it  can  be  concluded  that  the  compensation  for 
target  motion  can  improve  the  performance  of  the  human  operator 
significantly  in  certain  kinds  of  tasks. 
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APPENDIX  A.  ANALOGIC  AN5400  AND  DRll-C 


The  AN5400  is  connected  to  the  PDPll/34  through  a  DRll-C 
parallel  interface.  Jumpers  are  made  giving  the  DRll-C  device 
address:  767770,  interrupt vector  addresses:  300/304,  and  inter¬ 
rupt  level:  5.  Tables  A.l  and  A. 2  show  the  cable  connection 
between  the  DRll-C  and  the  AN5400. 

The  connections  between  the  AN5400  and  the  experimental  de¬ 
vices  are  done  through  20-pin  flat  cable  cinch  connectors. 

Tables  A.  3  and  A.  4  shov/  the  pin  assignment  of  the  connectors. 

An  assembly  language  program  AN5402  is  made  to  enable  the 
FORTRAN  programs  to  transfer  data  through  the  AN5400  (see  Ap¬ 
pendix  E) .  It  consists  of  seven  subroutines:  ANINIT,  AIN,  AINSQ, 
AOUT,  AOUTSQ,  DIN,  and  DOUT.  For  an  example  of  the  time 
required  for  the  data  transfer,  the  subroutines  AINSQ  requires 
approximately  (37n  +  63)  microseconds  to  get  analog  data  from  n 
successive  channels. 


Table  A.l. 

Cable  Connection  Between  DRll-C  and  AN5400  (1) 


DRll 

PIN 

-C  PI 

NAME 

AN5400  GPI 

PIN  NAME 

1 

A 

2 

B 

3 

C 

OUTOO 

35 

B0D16 

4 

D 

5 

E 

6 

F 

7 

H 

8 

J 

GND 

1 

DIG  GND 

9 

K 

OUTOl 

36 

BOD15 

10 

L 

OUT04 

39 

BOD12 

11 

M 

GND 

12 

N 

OUT05 

40 

BODll 

13 

P 

INIT  H 

14 

R 

OUT06 

41 

BODIO 

15 

S 

GND 

16 

T 

OUT07 

42 

BOD9 

17 

U 

0UT03 

38 

B0D13 

18 

V 

GND 

19 

W 

OUT08 

5 

B0D8 

20 

X 

OUT09 

6 

BOD  7 

21 

Y 

GND 

22 

Z 

OUTIO 

7 

BOD6 

23 

AA 

OUT  11 

8 

BODS 

24 

BB 

OUT12 

9 

BOD4 

25 

CC 

GND 

26 

DD 

CSRl 

(8) 

27 

EE 

GND 

(4) 

28 

FF 

OUT  13 

10 

BOD3 

29 

HH 

OUT14 

11 

BOD  2 

30 

JJ 

OUT15 

12 

BODl 

31 

KK 

GND 

32 

LL 

REQ  A 

4 

DONE 

33 

MM 

GND 

34 

NN 

OUT02 

37 

BOD14 

35 

PP 

GND 

2 

DIG  GND 

36 

RR 

OUT02 

37 

SS 

GND 

38 

TT 

39 

UU 

GND 

3 

DIG  GND 

40 

W 

N.D. READY 

34 

DATA  READY 

DRll 

PIN 

-C  P2 

NAME 

AN5400  GPI 

PIN  NAME 

40 

W 

39 

UU 

GND 

20 

DIG  GND 

38 

TT 

INOO 

43 

BID16 

37 

SS 

GND 

36 

RR 

INIT  H 

35 

PP 

GND 

(5) 

34 

NN 

INIT  H 

(9) 

33 

MM 

GND 

19 

DIG  GND 

32 

LL 

INOl 

44 

BID15 

31 

KK 

IN04 

47 

BID12 

30 

JJ 

GND 

29 

HH 

IN05 

48 

BIDll 

28 

FF 

27 

EE 

IN06 

49 

BIDIO 

26 

DD 

GND 

25 

CC 

IN07 

50 

BID9 

24 

BB 

IN03 

46 

BID13 

23 

AA 

GND 

22 

Z 

IN08 

13 

BID8 

21 

Y 

IN09 

14 

BID7 

20 

X 

GND 

19 

w 

INIO 

15 

BID6 

18 

V 

INll 

16 

BIDS 

17 

u 

IN12 

17 

BID4 

16 

T 

GND 

(3) 

15 

S 

REQ  B 

(7) 

14 

R 

GND 

13 

P 

IN13 

33 

BID3 

12 

N 

IN14 

32 

BID2 

11 

M 

IN15 

31 

BIDl 

10 

L 

GND 

(2) 

9 

K 

CSRO 

(6) 

8 

J 

GND 

18 

DIG  GND 

7 

H 

IN02 

45 

BID14 

6 

F 

5 

E 

IN02 

4 

D 

3 

C 

D.TRANSM'D 

2 

B 

1 

A 
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AN5400  GPI 

PIN  NAME 

DRll-C 

PIN  NAME 

1 

DIG  GND 

PI-  J  8 

2 

DIG  GND 

Pl-PP  35 

3 

DIG  GND 

Pl-UU  39 

4 

DONE 

Pl-LL  32 

REQ  A 

5 

BODS 

PI-  W  19 

OUT08 

6 

B0D7 

PI-  X  20 

0UT09 

7 

B0D6 

PI-  Z  22 

OUTIO 

8 

BOD5 

Pl-AA  23 

OUTll 

9 

B0D4 

Pl-BB  24 

OUT12 

10 

B0D3 

Pl-FF  28 

0UT13 

11 

B0D2 

Pl-HH  29 

0UT14 

12 

BODl 

Pl-JJ  30 

0UT15 

13 

BIDS 

P2-  Z  22 

IN08 

14 

BID7 

P2-  Y  21 

IN09 

15 

BID6 

P2-  W  19 

INIO 

16 

BID5 

P2-  V  18 

INll 

17 

BID4 

P2-  U  17 

IN12 

18 

DIG  GND 

P2-  J  8 

19 

DIG  GND 

P2-MM  33 

20 

DIG  GND 

P2-UU  39 

21 

22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

BIDl 

P2-  M  11 

IN15 

32 

BID2 

P2-  N  12 

IN14 

33 

BID3 

P2-  P  13 

IN13 

34 

DATA  READY 

Pl-W  40 

N.D. READY 

35 

B0D16 

PI-  C  3 

OUTOO 

36 

BODl  5 

PI-  K  9 

OUTOl 

37 

BOD14 

Pl-NN  34 

0UT02 

38 

BODl  3 

PI-  U  17 

OUT03 

39 

BOD  12 

PI-  L  10 

0UT04 

40 

BODll 

PI-  N  12 

OUT05 

41 

BODIO 

PI-  R  14 

OUT06 

42 

BOD9 

PI-  T  16 

0UT07 

43 

BID16 

P2-TT  38 

INOO 

44 

BID15 

P2-LL  32 

INOl 

45 

BID14 

P2-  H  7 

IN02 

46 

BID13 

P2-BB  24 

IN03 

47 

BID12 

P2-KK  31 

IN04 

48 

BIDll 

P2-HH  29 

IN05 

49 

BIDIO 

P2-EE  27 

IN06 

50 

BID9 

P2-CC  25 

IN07 

Table  A. 2. 

Cable  Connection  Between 
DRll-C  and  AN5A00  (2) 


9-PIN 

CONN. 

DRll 

PIN 

-C 

NAME 

1 

2 

P2-  L  10 

GND 

3 

P2-  T  16 

GND 

4 

P2-EE  27 

GND 

5 

P2-PP  35 

GND 

6 

P2-  K  9 

CSRO 

7 

P2-  S  15 

REQ  B 

8 

Pl-DD  26 

CSRl 

9 

P2-NN  34 

INIT  H 

43- 


Table  A. 3. 

User  Connectors  Pin  Assignment  for  DRll-C  and  AN5400 


1.  DRll-C 


unused 

GND 

GND 

GND 

GND 


CRSO  (output  from  PDPll/34) 
REQ  B  (input  to  PDPll/34) 

CSRl  (output  from  PDPll/34) 
INIT  H  (output  from  PDPll/34) 


Device  Addresses:  767770(STATUS) ,  767772 (OUTPUT) ,  767774 (INPUT) 
Interrupt  Vector  Addresses:  300(REQ  A),  304 (REQ  B) 

Interrupt  Level:  5 


For  details  see  DRll-C  manual. 


2.  AN5400 


2.1. 

DIGITAL  INPUT 

32 

bits. 

(2  connectors. 

16 

bits  for 

each,  addresses: 

20 

and 

22 

decimal) 

2.2. 

DIGITAL  OUTPUT 

32 

bits . 

(2  connectors. 

16 

bits  for 

each,  addresses: 

24 

and 

26 

decimal) 

2.3. 

ANALOG  INPUT 

32 

channels . 

(2  connectors. 

16 

channels 

for  each. 

addresses:  0  - 

15 

and  16  - 

31  decimal) 

The  A/D  works  in  Single-Ended  operation.  But  the  input  signal 
is  measured  with  respect  to  Signal  Return,  not  Analog  Ground. 
This  feature  is  called  'Pseudo-Differential"  operation. 


2.4.  ANALOG  OUTPUT  16  channels. 

(2  connectors,  8  channels  for  each, 
addresses:  4-11  and  12  -  19  decimal) 
Return  Sense  leads  are  omitted. 

Returns  are  connected  to  Analog  Ground. 
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Table  A, 4.  User  Connectors  Pin  Assignment  for  AN5400 


Connectors  are  943-1205  FCC-110-20. 
DIGITAL  INPUT 


unused 

1 

2 

DIG  GND 

(MSB)  1 

3 

4 

2 

3 

5 

6 

4 

5 

7 

8 

6 

Input  7 

9 

10 

8  Input 

bits  g 

11 

12 

10 

11 

13 

14 

12 

13 

15 

16 

14 

15 

17 

18 

16  (LSB) 

DIG  GND 

19 

20 

unused 

DIGITAL  OUTPUT 


unused 

1 

2 

DIG  GND 

(MSB)  1 

3 

4 

2 

3 

5 

6 

4 

5 

7 

8 

6 

Output  7 

9 

10 

8  Output 

bits  g 

11 

12 

10 

11 

13 

14 

12 

13 

15 

16 

14 

15 

17  i 

18 

16  (LSB) 

DIG  GND 

19 

20 

unused 

ANALOG  INPUT 


ANALOG  OUTPUT 


SIGNAL  RTRN 

1 

2 

0 

3 

4 

2 

5 

6 

4 

7 

8 

Input  6 

9 

10 

channels  g 

11 

12 

10 

13 

14 

12 

15 

16 

14 

17 

18 

ANALOG  GND 

19 

20 

ANALOG  GND 
I 
3 
5 

7  Input 
g  channels 

11 

13 

15 

unused 


LOADO 
OUTO 
OUTl 
OUT2 
OUT3 
0UT4 
OUT5 
OUT6 
OUT  7 
LOAD4 


1 

2 

3 

4 

5 

6 

7 

8 

9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 

DIG  GND 
RETURNO 
RETURN 1 
RETURN2 
RETURN! 
RETURN4 
RETURN5 
RETURNS 
RETURN? 
DIG  GND 


For  details  see  AN5400  Manuals. 
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APPENDIX  B.  MANIPULATOR  INTERFACE 

Figures  B.l  through  B.6  show  the  construction  of  the  man¬ 
ipulator  servos. 

Figure  B.7  shows  the  circuit  for  the  control  mode  switch¬ 
ing.  Two  manual  switches  on  the  panel  are  used  to  enable  and 
disable  the  computer  to  change  the  modes.  When  the  enable 
switch  is  pushed,  the  enable  state  is  held  by  the  self-holding 
relay  circuit  until  the  disable  switch  is  pushed  or  the  power 
is  shut  off.  An  LED  light  indicates  the  enable  state. 

In  the  enable  state  the  computer  can  select  the  mode 
through  a  digital  output,  while  in  the  disable  state  the 
manipulator  is  kept  in  the  master/slave  mode  regardless  of  the 
signals  from  the  computer. 

Seven  bits  of  the  word  of  digital  output  are  used  for  mode 
switching.  Each  of  them  can  change  the  mode  of  its  correspond¬ 
ing  joint  angle  of  the  manipulator.  One  bit  of  the  word  is 
used  to  inhibit  computer  control.  In  normal  operation  this  bit 
is  set  to  zero.  The  use  of  this  bit  invalidates  the  spurious 
signal  of  all  ones  that  comes  when  the  cable  is  disconnected. 

The  one  kiloohm  resistors  placed  in  parallel  to  the  relay  con¬ 
tacts  protect  the  contact  points  which  switch  inductive  loads. 

Figure  B.8  shows  the  breadboard  wiring  of  the  circuit. 

A  modification  is  made  on  the  comparator/modulator  chassis 
(Fig.  B.2).  A  switch  is  added  to  each  chassis  which  is  meaning¬ 
ful  only  in  the  master/slave  mode.  When  on  it  allows  the  D/A 
signal  from  the  computer  to  operate  as  the  angular  difference 
between  master  and  slave  in  master/slave  mode,  and  when  off  it 
makes  the  D/A  signal  irrelevant. 
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Fig.  B.l. 


Servo  Control  Rack  Schematic 


(from  Brooks [ 3 ] ) 
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Fig.  B,3.  Comparator  Circuit  Schematic  (from  Brooks [3]) 


2N270  2N270  2N270  2N270 
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Modulator  Circuit  Schematic  (from  Brooks [3]) 


Fig.  B.5.  Gearbox  Schematic  (from  Brooks [3]) 


Fig,  B,7,  Drawing  of  Control  Mode  Switching  Circuit 


Breadboard  Wiring  of  Control  Mode  Switching  Circuit 


1 


APPENDIX  C.  THE  TABLE  AND  ITS  INTERFACE 

A  table  having  a  carriage  which  moves  along  the  x,  y,  and 
z  axes  is  provided  for  the  project.  The  carriage  is  driven  by 
three  stepping  motors,  z  overriding  x  and  x  overriding  y.  The 
motion  is  realized  by  a  timing  belt-pulley  mechanism  along  the 
X  and  y  axes  and  by  rack-and-pinion  along  the  z  axis.  The  strokes 
are  14  inches,  16  inches,  and  2  inches  along  x,  y,  and  z  axes, 
respectively.  A  translator  is  used  to  convert  the  forward  and 
reverse  pulse  signals  into  the  phase-shifting  motor  driving 
currents . 

An  interface  circuit  was  made  for  the  computer  to  control 
the  table.  Figure  C.l  shows  the  circuit.  The  most  interest¬ 
ing  IC  chip  used  in  this  circuit  was  the  TTL  7497  Binary  Rate 
Multiplier.  Essentially,  it  has  six  bits  of  rate  input  and  one 
clock  input  and  one  clock  output,  and  it  outputs  as  many  clock 
pulses  for  every  64  input  clock  pulses  as  specified  by  the  six 
bits  (0  -  63).  The  crystal  oscillator  generates  4.1943  MHz 
clock  pulse  and  the  first  BRfI  counts  it  down  to  0  -  63  (set 
by  the  manual  switches)  for  every  64.  The  next  two  4-bit 
counters  in  series  count  it  down  to  one  sixty-fourth.  Next 
come  three  BRM's,  each  of  which  counts  the  pulse  down  to  0  -  15 
(set  by  the  digital  output  signals  from  the  computer)  for  every 
64.  In  this  sequence,  the  last  counter  can  output  0,  1(1  x  1), 
up  to  945(63  X  15)  pulses  per  second. 

The  computer  gives  16  bits  of  digital  output  signal  to 
this  circuit.  Fifteen  of  the  bits  are  given  to  the  three  axes 
five  for  each.  One  of  the  five  bits  specifies  the  direction, 

"one"  forward  and  "zero"  reverse,  and  the  remaining  four  bits 
assign  the  sixteen  levels  of  pulse  rate  (0  -  15) .  The  last  one 
bit  inhibits  the  pulse  output  of  the  circuit.  This  invali¬ 
dates  the  spurious  signal  of  all  ones  that  come  when  the  cable 
is  disconnected. 
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If  the  computer  is  working  with  a  20  Hz  clock,  the  manual 
rate  switch  can  be  set  20,  and  the  computer  can  update  the  digital 
output  every  twentieth  of  a  second  giving  the  motor  0  to  15 
pulses  every  cycle,  resulting  in  0  to  300  pulses  per  second. 

The  cable  from  the  panel,  used  in  place  of  that  from  AN5400, 
allows  manual  test  of  the  motor  drive. 

Figure  C.2  shows  the  breadboard  wiring  of  the  circuit. 
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Breadboard  Wiring  of  Table  Circuit 


APPENDIX  D.  TABLES  OF  EXPRESSION  OF  VARIABLES 


Table  D.l  Transform  Matrix  from  Frame  4  to  Frame  0 


■4 

4 

4 

4 

^12 

^13 

^14 

4 

4 

4 

4 

^21 

^22 

^23 

^24 

4 

4 

4 

4 

^31 

^32 

^33 

^34 

0 

0 

0 

1 

1 

:  C2C4 

+  S2S3S4 

a^2  =  S2S3C4-C2S4 
‘a^2  =  2203 


=  S1S2C4  +  C1C3S4  -  S1C2S3S4 
^a22  =  C1C3C4-S1C2S3C4-S1S2S4 


323  =  -S1C2C3-C1S3 


^31  ^  -C1S2C4+S1C3S4+C1C2S3S4 
*3^2  =  S1C3C4+C1C2S3C4+C1S2S4 
*333  =  C1C2C3-S1S3 


a,,  =  X  =  1.39(S2S3C4-C2S4)-40S2C3 
14 

^324  =  y  =  1.39(C1C3C4-S1C2S3C4-S1S2S4)+40(S1C2C3+C1S3)+18C1 

=  z  =  1.39(SlC3C4+ClC2S3C4+ClS2S4)+40(-ClC2C3+SlS3)+13Sl 
34 


4-> 

,4 

4 

4 

X  = 

^21' 

^31 

4->- 

,4 

^  ®12' 

4 

4 

y  = 

®22' 

^32 

4->- 

,4 

(  aj_3, 

4 

4 

z  = 

^23' 

^33 
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Table  D.2  Transform  Matrix  from  Frame  6  to  Frame  0 


6 

6 

6 

^11 

^12 

^13 

^14 

6 

6 

6 

®21 

^22 

^23 

^24 

^31 

^32 

*^34 

0 

0 

0 

1 

(C2C4+S2S3S4) C6+ [-S2C3C5+ (S2S3C4-C2S4 ) S5]  S6 
(S2S3C4-C2S4) C5+S2C3S5 

[S2C3C5+(-S2S3C4+C2S4) S5]C6+(C2C4+S2S3S4) S6 

{S1S2C4+C1C3S4-S1C2S3S4) C6 

+  [  (S1C2C3+C1S3) C5+ {C1C3C4-S1C2S3C4-S1S2S4) S5] S6 

(C1C3C4-S1C2S3C4-S1S2S4)C5-{S1C2C3+C1S3) S5 

[-(S1C2C3+C1S3) C5+{~C1C3C4+S1C2S3C4+S1S2S4) S5]C5 
+(S1S2C4+C1C3S4-S1C2S3S4) S6 


a^^  =  (-C1S2C4+S1C3S4+C1C2S3S4)C6 

+  [  (-C1C2C3+S1S3) C5+(S1C3C4+C1C2S3C4+C1S2S4) S5] S6 
"a32  =  (S1C3C4+C1C2S3C4+C1S2S4)C5+(C1C2C3-S1S3)S5 

’a23  =  [  (C1C2C3-31S3) C5-(S1C3C4+C1C2S3C4+C1S2S4) S5JC6 

+  (-ClS2C4+SlC3S4+ClC2S3S4)  S6 

’a^4  =  X  =  1.39(S2S3C4-C2S4)~40S2C3 

=  y  =  1.39(C1C3C4-S1C2S3C4-S1S2S4)+40(S1C2C3+C1S3)+18C1 

’a,,  =  z  =  1,39(S1C3C4+C1C2S3C4+C1S2S4)+40(-C1C2C3+S1S3)+18S1 
34 


(%1, 

6 

6 

®21' 

^31 

(%2' 

6 

6 

®22' 

^32 

^  ^13' 

6 

6 

®23' 

^33 
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Table  D.3  Expression  of  the  Variables  Used  in  the  RMRC 

X  =  1.39(S2S3C4-C2S4)-40S2C3 
=  0 

3x/3e2  =  1.39(C2S3C4+S2S4)-40C2C3 
3x/392  =  1.39S2C3C4+40S2S3 
3x/36^  =-1.39(C2C4+S2S3S4) 

y  =  1.39(C1C3C4-S1C2S3C4-S1S2S4)+40(S1C2C3+C1S3)+18C1 

=-1.39(SlC3C4+ClC2S3C4+ClS2S4)  +40  (C1C2C3-S1S3)  -18S1 
3y/3e2  =  1.39(S1S2S3C4-S1C2S4)-40S1S2C3 
3y/303  =-l. 39 (S1C2C3C4+C1S3C4) +40 (C1C3-S1C2S3) 

3y/3e4  =  1.39(-S1S2C4-C1C3S4+S1C2S3S4) 

z  =  1.39(SlC3C4+ClC2S3C4+ClS2S4)+40(-ClC2C3+SlS3)+18Sl 
3z/30^  =  1.39 (C1C3C4-31C2S3C4-S1S2S4) +40 (S1C2C3+C1S3) +18C1 
3Z/302  =  1,39(-C1S2S3C4+C1C2S4)+40C1S2C3 
3Z/392  =  1.39(C1C2C3C4-S1S3C4)+40(S1C3+C1C2S3) 

3z/30^  *  1.39{C1S2C4-S1C3S4-C1C2S3S4) 

p  =  s''*aj_3^+'^a^2  =  s-Px+py 
px  =  C2C4+S2S3S4 
3px/39j_  =  0 

3px/302  =  -S2C4+C2S3S4 
3px/303  =  S2C3S4 
3px/30^  =  S2S3C4-C2S4 

py  =  S1S2C4+C1C3S4-S1C2S3S4 
3py/30j^  =  C1S2C4-S1C3S4-C1C2S3S4 
3py/302  =  S1C2C4+S1S2S3S4 
3py/  303  =  -S1C2C3S4-C1S3S4 
3Py/394  =  C1C3C4-S1C2S3C4-S1S2S4 

For  ^y  to  be  horizontal, 

(S1C3C4+C1C2S3C4+C1S2S4)C5+{C1C2C3-S1S3)S5  =  0, 
which  gives 

Ogj.  =  arctan  [- {S1C3C4+C1C2S3C4+C1S2S4) /(C1C2C3-S1S3)  ] 

(cont 'd) 
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Page  Two 
Table  D.3 


For  to  be  horizontal, 

(-C1S2C4+S1C3S4+C1C2S3S4)C6 

+[ (-C1C2C3+S1S3)C5+(S1C3C4+C1C2S3C4+C1S2S4)S5]S6  =  0 
which  gives 

0,  =  arctan [ (-C1S2C4+S1C3S4+C1C2S3S4) 

6r 

/{ (C1C2C3-S1S3)C5- (S1C3C4+C1C2S3C4+C1S2C4) S5}] 
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Table  D.4  Simplified  Expression  of  the  Variabi os  Used  in  the  RMRC 
Notation 

For  example,  xl  =  Sx/3d^,  px3  =  Spx/BO^- 

Variables  beginning  by  a  capital  letter  are  temporary  variables. 

Ypart  =  S1C2C3+C1S3 
Zpart  =  -C1C2C3+S1S3 
X2part  =  C2S3C4+S2S4 
Pz4  =  SlC3C4+Cl-X2part 

px  =  C2C4+S2S3S4 
pxl  =  0 

px2  =  -S2C4+C2S3S4 

px3  =  S2C3S4 

px4  =  S2S3C4-C2S4 

py  =  -Sl-px2+ClC3S4 

pyl  =  -Cl-px2-SlC3S4 

py2  =  Sl’px 

py3  =  -Ypart *34 

py4  =  ClC3C4-Sl-X2part 

X  =  1. 39px4-40S2C3 
y  =  1 . 39py4+40Ypart+18Cl 
z  =  1.39Pz4+40Zpart+18Sl 

xl  =  0 

x2  =  1. 39X2part-40C2C3 
x3  =  1. 39S2C3C4+40S2S3 
x4  =  -1.39px 

yl  =  -z 

y2  =  1. 39Sl-px4-40SlS2C3 

y3  =  -1.39Ypart-C4+40 (C1C3-S1C2S3) 

y4  =  -1.39py 

zl  =  y 

z2  =  1.39Cl*px4+40ClS2C3 

z3  =  -1.39Zpart*C4+40(SlC3+ClC2S3) 

z4  =  1.39  pyl 


(cont ’ d) 


Page  Two 
Table  D.4 


F123  =  S1C3+C1C2S3 
TN5  =  F123 •C4+C1S2S4 
TD5  =  C1C2C3-S1S3 

=  arctan  (-TN5/TD5) 

=  arctan[(-ClS2C4+F123*S4)/(TD5-C5-TN5-S5) ] 
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APPENDIX  E.  PROGRAM 

The  program  consists  of  the  main  part  MANEXl ,  resolved 
motion  rate  control  subroutines  MRESS  and  MRESM,  voltage-radian 
conversion  subroutine  MANGL,  and  AN5400  controlling  subroutine 
AN5402. 

MANEXl  generates  the  object  motion  and  controls  the  master/ 
slave  operation  as  described  in  Chapter  6.  MRESS  and  MRESM 
are  the  same  except  that  they  deal  with  different  areas  of  the 
data  (MRESS  for  the  slave  and  MRESM  for  the  master) .  Such  dup¬ 
lication  could  be  avoided  in  assembly  language  coding  by  use 
of  an  index  register  to  switch  the  data  area,  or  still  better 
and  faster,  by  use  of  the  memory  management  register  if  possible 
as  with  the  PDPll/34. 

The  singularity  of  the  Jacobian  matrix  was  not  taken  care 
of  in  the  program  assuming  that  operators  do  not  give  the 
manipulator  such  posture  that  makes  the  matrix  singular. 

Figure  E.l  shows  the  general  flowchart  of  the  program. 
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tmNIPulator  and  table 

.-tANIPLiLATION  GF  MOVING  OBJECT 

COMMON  THXSI 7)  .  THXMI  i' 7  ) ,  THXSO  (  7  )  f  THXmO  (  7  ) 

COMMON  THSl • THS2 » THS3 f THSA » THS5 » THS^ » X3 »  YS f 73 > hS • XSH . I  SB » ZSB » 5SD 
COMMON  THMl »THM7»THM3.THM4.THM5.THM6»XM» ( M , ZM . SM f  ^MH , f MB f .MB , SMD 
COMMON  IBATA(14) 

THXbOt 1 )=0.0 
THXMO( 1)=0.0 


CALL  ANINIT 
CALL  DCUT(Z4.0) 
call  B0UT'.2i*0) 

TY-'E  *,  MANIPULATION  OF  MOVING  OBJECT  WITH  COMPENSATION' 
A  =  0 . 7 
B  =  u .  5 
A 1  =  1  *  0  "  A 

TVFF  *.  MANIPULATOR-  COMPUTER  CONTROL^' 

ACCEPT  4*1 

IFvI.NE.l)  STOP 

CALL  AINSOUo.ZR.IBATA) 

CALL  AOUTSan.lZflBATA) 

CALL  DUUT<24*43) 

SINUSOIDAL  MOTION  OF  THE  TABLE 
STOPS  UHEN  AN5400  DIhL  IS  NON-ZERO 
STOPS  WHEN  ANY  LIMIT  SWITCH  IS  HIT 
STOPS  WHEN  TIME  FAILURE  DCCURS 

TYPE  **'SET  FUNDAMENTAL  FREOUENCIES  FX=FY=FZ=20HZ ' 

ACCEPT  *fl 
IF(I.NE.l)  STOP 
PT1=5.0 
r 12=0.5 
F'T3=U.5 
T4=13.5 

PU  1=0. 31 4 16/PTl 
f  U2  =  0.51416/PT2 
PW3=0.31416/PT3 
,-W4  =  0.3141A/PT4 

TYPE  *.'SET  TABLE  AT  CENTER  AND  TURN  ON  TRANSLATOR' 

TYPE  **'THIS  INITIATES  COMPUTER  CONTROLLED  MASTER/SLAVE' 
ACCEPT  tfl 
IF(I.NE.l)  STOP 

T2t'l=-20.0 
I<=0 
IY  =  0 
IZ  =  0 
r«i=o 

IY1=0 
IZ1--0 
1X2  =  0 
I  .2  =  0 

:z2=o 
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1X3  =  0 
I';  3  =  0 
133=0 
:  =  0.0 
r:=0.0 
3  =  0.0 
XI =0.0 
Y1=0.0 
21=0.0 
X2  =  0.0 
f2=0.0 
32=0.0 
X  3  =  0 . 0 
r3-u'  .0 
33  •  .0 

Tl  =  SECNDSi,0.0)+4.0 
GO  TO  500 

r 

w 

C  'ASLE  MOTION 

100  IZ  =  ININTi,34.0*COS(T20*PUl)-34.0*COS(T20*PU2^  ) 

i;<  =  ININT(100.0*SIN(T20i|!PWl)-400.0»SIN<T20*PW3)  ) 
rr  =  ININTi,  100.0*51  N(T204[pW2) -400. 0*SIN(T20*PU4) ) 
X=0.014*FL0AT(1X) 

Y  =  0.014*FL0ATaY) 

2=0.0117809*FLOAT(IZ) 

IVX=IX1-IX2 
IVY=IY1-IY2 
102=122-133 
ISX  =  1 

r  s  ('  =  1 

IS2  =  1 

(I0X.6T.0)  GO  TO  120 
I3X  =  0 
IOX=-IUX 

120  IFi lOY.GT.O)  60  TO  130 

ISY=0 
IOY=-IVY 

130  IF'!  IVZ.GT.O)  GO  TO  140 

ISZ=0 
IOZ=-IVZ 

140  JDAT A= 1 6384*1 SZ+51 2*1 SY+16*ISX 

JDATA  =  JtiATA+1024*IVZ+32*iyy  +  IVX 
CALL  riOUT(26f  JDhTA) 

C 

C  MASTER/SLAOE 

300  CALL  MaNGLI 

TH31=THXSI(5) 

TH52=THXSI(7) 

TH53=THXSI(6)-THS1 

TH34=THXSI(2) 

CALL  MPESSl 
rHMl  =  TH<Mn5 
THM2=THXMI(7) 
i  Hf13  =  THXMI '  o)-THMl 
THM4=THXMI(2) 
call  MREGMl 
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XSE=XS-X2 
■rSE  =  YS-Y2 
ZSE=ZS-Z3 
x;d=a#xm+ai*xse+x 

YSD=A*YM+A1#YSE+Y 
ZS[i=A)|:Z«  +  Al)t:ZSE  +  2 
SSD=AtSh  +  Al^iSS 
XMri=H*XSETAl*XM 
YilD=A*Y3E  +  Al*YM 
ZHIi=A*Z3£  +  Al*ZM 
SHD=A4iSS  +  Al*S« 

IF(T20.LT.-5.0)  60  TO  320 
X3D  =  XCD  +  B)li(X3E-XSE2) 
YSIi=Y3ri+B*(Y3E-YSE2) 

23D=ZSr:  +  Ei*(ZSE-23E2) 

3SD=33D>B*(33-SS2) 

x«r!=XHri+B*(Xrt-XM2) 

YMIi=Yfir!  +  B*(  YM-YM2) 
ZhD=ZMD+B*(ZM-ZH2) 

3Mri=3Mri  +  Bi(S«-3M2) 

320  CALL  rtRE3S2 

CALL  rtRESMZ 
C 

rHSI6=(THXSI(4)-THXSI<3) )/1.65-THS6 

THMI6=(THX«I(4)-THXMI(3>)/1.65-THM6 

THS06=A»THMI3+AUTHSI6+THS6 

THi<06=A*THSI6+Al*TH«I6+THM6 

rF(T20.LT.-10.0)  GO  TO  340 

THS06=TH306+B*<THSI6-THSI62) 

THM06=THM06+B*(THMI6-THMI62) 

340  CONTINUE 

C 

THX30(2)=TH34 

THXSO(3)=TH35-TH306*0.825-THS3*0.27 

THXS0(4)=TH35  +  THS0<i4!0.825-THS3*0.27 

THX30(5)=TH31 

THXS0(6.)  =  THSlfTHS3 

THX30(7)=TH52 

THXM0(2)=THM4 

THXMO(3)=THM5-THM06*0.825-THM3*0.27 

THXM0(4)=TH«5+THM06*0.825-TH«3*0.27 

THX«0<5)=THM1 

THXM0(6)=THM1+THM3 

THXM0(7)=THM2 

CALL  hANGLO 

CALL  A0UTSQ(4> 17f IBATA) 

C 

400  T201=T201+1.0 

IX3=IX2 
IY3=IY2 
1 : 3  =  I  •  2 
1x2-  :ai 
.  ■ :=  fYt 
1Z2=[Z1 
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IX1=IX 
I 't  1  =  I Y 
IZ1  =  IZ 
>.3  =  X2 
Y3=Y2 
Z3  =  Z2 
X2  =  X1 
Y2  =  Y1 
Z2  =  21 
X1=X 
Y!  =  Y 
:i=z 

x<^E2  =  XSEl 

, -E2=YGE1 

:SE2=ZSE1 

i:^2  =  SSl 

THSI63=THSI61 

j(.'i2=Yrll 

?M2=YH1 

Zn2=ZMl 

3M2=Srtl 

rHMU2  =  THHl61 

X3E1=X3E 

YSE1=YSE 

ZSE1=23E 

331=33 

rH3I61=THSI6 

:<H1  =  XH 

VM1=YM 

;:;u=zM 

Sh  1  =Sf1 
rHrtI61=rHNI6 

500  CALL  DIN(256* JDATA) 

IF( JDATA.NE.O)  GO  TO  900 
CALL  0IN(20f JOATA) 

IF(  JDATA. LT.O)  jriATA=jriATA H 3384  +  1 6384 
JDATA=JDATA-JDATA/64*64 
IF( JDATA. NE. 63)  GO  TO  920 
T20=AINT( (SECNDS(T1 )+0.008)*20.0) 

IF(T20.LT.T201)  GO  TO  500 
IF(T20.GT.T201)  GO  TO  <?10 
IF(T20.LT.0.0)  GO  TO  300 
GO  TO  100 

C 

920  CALL  D0UT(26»0) 

TYPE  ». 'LIMIT  SWITCH' 

60  TO  900 

910  CALL  DOUT<26fO) 

TYPE  I. 'TIME  FAILURE' 

GO  TO  900 

900  CALL  DOUT(26iO» 

TYPE  TABLE  STOPPED^  MANIPULATOR  LEFT  UNRELEASED' 
TYPE  *f'TURN  OFF  MANIPULATOR' 

STOP 

END 
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SUBROUTINE  MRESSl 

COMMON  THXSK?)  »THXMI(7)  fTHXS0(7)  f  THXM0(7) 

COMMON  THl »TH2jTH3»TH4»TH5.TH6f X.Yf Z>3fXDf YDfZD.SD 
COMMON  FILLER(14> 

COMMON  niATA(14) 

EQUIVALENCE  ( A1 1 . X2 ) » ( A12 f XI ) » ( A1 3 » X4 ) ,( A14 * X3 ) 

EQUIVALENCE  ( A21 » Z2 ) » < A22 . 21 ) • ( A23 » Z4 ) » ( A24 » Z3 ) 

EQUIVALENCE  ( A31 » P2»  RY2 ) .  ( A32»  fl  i  F'Y  1 ) » (  A33 » P4  f  PY4  )  » (  A34 1  R3  » R  Y3  ) 
EQUIVALENCE  ( A41 . Y2) » ( A42» Y1 ) . < A43. Y4 ) » ( A44 » Y3 ) 

EQUIVALENCE  (G1  »DX*IiTH2) » (Q2»riZ»IiTHl ) ,  ( Q3 »  DP .  DTH4 )  f  (  U4 » DY ,  DTHS  ) 
EQUIVALENCE  ( P. PY ) » ( 3D> TX ) 

RESOLVED  MOTION  RATE  CONTROL 
Cl=COS(THl ) 

C2=C0S(TH2) 

C3=C0S(TH3j 

C4=C0S(TH4) 

S1=SIN( TIM  ) 

32=SIN(TH2> 

,:3:^;:IN(TH3) 

'.;-4  =  SIN(TH4) 

ClC3  =  Cl.i:C3 
i;tS3  =  C:«S3 
S1C3=31*C3 
3133=31*33 
C2C4=C2*C4 
C2S4=C2*S4 
S2C4=S2*C4 
.'CSA  =32*34 

i'PART=C1S3  +  31C3*C2 

ZPART=-C1C3*C2+S1S3 

X2PART=C2C4*S3+S2S4 

PZ4=C1*X2PART+31C3*C4 

PX=C2C4FS2S4*G3 

PXl=i;.0 

PX2=C2S4*S3-32C4 

PX3=S234»C3 

PX4=-C2S4+32C4*S3 

F'Y  =  C1C3*S4-S1#PX2 

pyi=-Cl*PX2-31C3»S4 

PY2=31*PX 

PY3=-yPART*S4 

PY4=C1C3*C4-S1*X2PART 

X=1 .3y*PX4-40.0*S2*C3 

Y=1 .39#PY4  +  40.0*YPART  +  18.0*C1 

Z=1 .39*PZ4+40.0*ZPART+18.0*S1 

S=- PY/PX 

X1=0.0 

X2=l .39«X2PART-40.0*C2*C3 
X3=l .39*S2C4*C3+40.C*S2*S3 
Y,4  =  -l  .39*PX 
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Vl  =  -Z 

Y2=l  .39!(tSl*F'X4-40.0*31C3*S2 

Y3=-l .39*YPART*C4+40.0«(C1C3-S1S3*C2) 

Y4=-1.39SPY 

Zl-Y 

Z2=-l .39*01 *PX4+40.0*C1C3*S2 

Z3  =  -l  .39»ZPAR‘T»C4  +  40.0*<C1S3*C2  +  S1C3) 

Z4=l .39»PY1 

Y=Y+40.0 

Z=Z-19.39 

RETlJRfJ 

ENTRY  MRES32 

P=PY4-TX»PX 

P2=PY2+TX*PX2 

F'3  =  PY3  +  TX*FX3 

F4=PY4+TX*PX4 

rip=-p 

iix=xri-x 

[iY=YD-f 


SOLVING  THE  RATE  EQUATION 

Ai:;=Ai3/Aii 

A23=(A23-A2UA13)/A22 

fi33=A33-A31*A13-A32»A23 

A43=A43-A41»A13-A42*A23 

AU  =  A14/A11 

A24=(A24-fi21IA14)/A22 

A34=(A34-A31*A14-A32*A24)/A33 

A44  =  A44-A41*A14-A42lA24-A43iiiA34 

Q1=Q1/An 

Q2=<Q2-A21*Q1 )/A22 

Q3=aT3-A31*Ql-A32*Q2)/A33 

Q4=(Q4-A41»Q1-A42*Q2-A43*Q3)/A44 

Q3=Q3-A34*a4 

Q2=Q2-A24*Q4-A23*Q3 

Cil=Ql-A14»Q4-A13*a3 

SOLVING  TH5  AND  TH6 

SS1=SI+DTH1*C1 

CC1=C1-0.5*DTH1*(SHSS1) 

3S2=S2+DTH2«C2 

!:C2  =  C2-0.5*riTH2*(S2  +  SS2) 

3S3=S3+DTH3*C3 

CC3=C3-0,5*DTH3*(S3+SS3) 

3S4=S4  +  [iTH4*C4 
CC4=C4-0.5*DTH4*<S4+SS4) 

C1C2=CC1«l;C2 

.:iS2  =  CCl*SS2 

P123=C1C2*353+SS1*CC3 

TN5=Pi:3*CC4+ClS2»SS4 

TD5=C1C2*CC3-SS1*S33 

TH5=ATAN2( -TN5.TD5) 

-Hi=ATAN2<Pl23*SS4-ClS2*CC4»Tri5*C0S(TH5>-TN5*SIN( TH5) ) 
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,MEU  TH1»TH2*TH3.TH4 

TH1=THUDTH1 

TH2=TH2+DTH2 

TH3=TH3  +  [ITH3 

TH4=:H4+DTH4 

RETURN 

ilNO 


SUBROUTINE  MRESNl 

COMMON  THXSI(7) »THXMI (7) *THXS0(7) f THXM0(7) 

COMMON  FILLER'(14) 

COMMON  THltTHOf TH3*TH4f TH5>TH6»Xt Y,2>S»XIi» YDf ZDf SD 
COMMON  IDATA(14) 


RETURN 

1/ 

ENTRY  MRECH2 


RETURN 

END 


SUBROUTINE  MANGLI 

COMMON  THXSI<7) .THXMI(7)fTHXSO<7)»THXMO(7) 

COMMON  FILLER(28) 

COMMON  IDATh(14) 

DIMENSION  COEF'T) f IC0NST(7) 

DATA  C0EF/.00048f .00142» .00173j-.00173»-.00043»-.00079, .00036/ 
DATA  IC0NST/0*0f 300.-300 f0.0»0/ 

C 

C  CONVERT  ANGLE  READINGS  INTO  RADIANS 

CALL  AINSll(l6.29.IDATA) 

DO  10  I=lr7 

THXSI(I)  =  FL0AT(IDATAa)/16-IC0NST(I)  )*COEF(I) 

THXMK I )=FL0AT(-IDATA(I+7)/16-IC0NST( I) )*COEF(I) 

10  CONTINUE 

RETURN 
C 

ENTRY  MANGLO 

C  CONVERT  ANGLE  RADIANS  INTO  OUTRUT  FORMS 

DO  20  1=1.7 

irATAa)  =  (  ININTi  THX50(n/C0£F<I))  +  IC0NST<I)  )»16 
II:ATA( I+7)=-i ININT(THXMO( I )/COEF( I) )+ICONST(I ) )#16 
20  CONTINUE 

RETURN 
END 
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•CONTROL 

.  SUBROUTINES  OF  AN5400 

THROUGH  DRII-C 

.GLOBL 

ANINIT»DIN»DOUT.AIN,AlNSQf AOUTf AOUTSQ 

•GLODL 

STATUS. OUTBUF. 

INBUF 

« 

din: 

T5T 

(R5)  + 

NOV 

♦20000.ro 

J'READ  DIGITAL  DATA’ 

ADD 

.?lR5)  +  .R0 

•+  ADDRESS 

DiNi : 

TSTB 

STATUS 

BPL 

[IINI 

rtOU 

RO.OUTBUF 

J INPUT  COMMAND 

DIN2: 

TSTB 

STATUS 

BPL 

DIN2 

MOV 

INBUF.|?(R5)  + 

; INPUT  DATA 

RTS 

PC 

« 

dout: 

TST 

;r5)  + 

MOV 

♦iioooo.ro 

S’LOAD  DAC  DATA’ 

ADD 

0(R5)+.RO 

!+  ADDRESS 

DOUTl ; 

TSTB 

STATUS 

Bf  L 

DOUTl 

MOV 

RO.OUTBUF 

; INPUT  COMMAND 

du'Jt:; 

TSTB 

STATUS 

BPL 

D0UT2 

MOV 

|?(R5)  +  .0UTBUF 

.‘OUTPUT  DATA 

RTS 

PC 

ain: 

TST 

(R5)  + 

MOV 

♦50000.ro 

{•LOAD  ADDRESS’ 

ADD 

0(R5)+.RO 

J+  ADDRESS 

^iNi : 

TSTB 

STATUS 

BPL 

AINl 

MOV 

RO.OUTBUF 

i OUTPUT  COMMAND 

AIN2: 

TSTB 

STATUS 

BPL 

AIN2 

CLR 

OUTBUF 

5 'READ  A/D  DATA’ 

AIN3: 

TSTB 

STATUS 

BPL 

AIN3 

MOV 

INBUF.(?(R5)  + 

f INPUT  DATA 

RTS 

PC 

f 

ainsq: 

TST 

(R5)  + 

MOV 

♦50000.ro 

I’LOAD  ADDRESS’ 

A  HD 

0(R5)+»RO 

;+  FIRST  address 

MOV 

♦50000. R1 

{’LOAD  ADDRESS’ 

ADO 

0(R5)+.R1 

;+  LAST  ADDRESS 

MOV 

(R5)+.R2 

;data  address 

AINSl : 

TSTB 

STATUS 

BMI 

AINS4 

BR 

AINSl 

AINS2: 

TSTB 

STATUS 

BPL 

AINS2 

CLR 

CUTBUF 

J’READ  A/D  DATA’ 

AINS3: 

TSTB 

STATUS 

BPL 

A I NS3 
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MOV 

AINS4: 

MOV 

INC 

CMP 

BLOS 

AINSS: 

TSTB 

BPL 

CLR 

AINS6; 

TSTB 

BPL 

MOV 

RTS 

.♦ 

aout: 

TST 

MOV 

ADD 

AOUTl; 

TSTB 

BPL 

MOV 

A0UT2 i 

{ 

TSTB 

BPI. 

MOV 

RTS 

AOUTSO: 

TST 

MOV 

ADD 

MOV 

ADD 

MOV 

AOSl  J 

TSTB 

BPL 

MOV 

A0S2: 

TSTB 

BPL 

MOV 

INC 

CMP 

BLOS 

RTS 

9 

ANINIT; 

CLR 

ANIl : 

TSTB 

BPL 

MOV 

ANT2: 

TSTB 

BPL 

MOV 

ANI3: 

TSTB 

BPL 

MOV 

5 

RTS 

.END 

INBUFf (R2)+ 

ROtOUTBUF 

RO 

ROfRl 

AINS2 

STATUS 

AINS5 

OUTBUF 

STATUS 

AINS6 

INBUF. (R2)+ 

PC 

(R5)  + 

♦iioooo.ro 

i?(R5)  +  .R0 

STATUS 

AOUTl 

RO. OUTBUF 

STATUS 

A0UT2 

(?(R5)  +  .  OUTBUF 
PC 

!R5)  + 

♦iioooo.ro 

5(R5)+.R0 

♦110000. R1 

e(R5)+.Rl 

(R5)+.R2 

STATUS 

AOSl 

RO. OUTBUF 

STATUS 

A0S2 

' R2)+. OUTBUF 
RO 

RO.Rl 

AU31 

PC 

STATUS 

STATUS 

ANIl 

♦170000. OUTBUF 

STATUS 

ANI2 

♦170000. OUTBUF 

STATUS 

AN  1 3 

♦60006. OUTBUF 
PC 


i INPUT  DATA 
; INPUT  CONMAND 


;‘READ  A/D  DATA* 


{INPUT  DATA 


{•LOAD  DAC  DATA* 
{+  ADDRESS 


{OUTPUT  COMMAND 


{OUTPUT  DATA 


{•LOAD  DAC  DATA* 
{+  FIRST  ADDRESS 
{•LOAD  DAC  DATA* 
{+  LAST  ADDRESS 
{DATA  ADDRESS 


;OUTPUT  COMMAND 


{OUTPUT  DATA 


{ •CLEAR* 


{•CLEAR*  AGAIN 


{’LOAD  STATUS* 
{CONV+SEQ 
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APPENDIX  F 


DATA 


o  a 


Table  F.2.  Operation  Time  for  the  Valve  Turning  Task 


TR  IhL 

SUBJECT 

SUBJECT 

NUnPER 

*  1 

*2 

1 

1 .  4 

13.6 

■J. 

15.0 

1  0  .  c, 

1  5  .  o 

o  »  o 

I-V  0  T  H  £<  L  £  n  0  T  I  0  N  4 

12.0 

3 . 3 

*“i 

14 .3 

12.0 

14.3 

1  ■)  -  9 

1.49 

1  . 

t 

k 

13.2 

19.6 

2 

15.3 

11.0 

..y 

14.0 

1  0 . 3 

C  U  M  F'  E  N  S  B  T  I  0  r  ' 

4 

1 ' .  3 

1  0 . 4 
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